SPECIFICATION 



POSITIONING DATA CALCXJLATING PROCEDURE, POSITIONING DATA 
CALCULATING APPARATUS AND ARTICULATED MANIPULATOR 

BACKGROUND OF THE INVENTION 
Field of the Invention 

The present invention relates to an articulated 
manipulator comprising a plurality of links, and joints 
rotatably connecting the links • More particularly, the 
present invention relates to an articulated manipulator 
comprising a plurality of links, and coaxial joints each 
for connecting the two adjacent links for coaxial 
rotation, and diagonal joints each for connecting the 
two adjacent links such that one of the two adjacent 
links makes a conical revolution relative to the other. 

Description of the Related Art 

Prior art related to articulated manipulators 
disclosed in, for example, JP62-148182A, JP56-163624A 
and JP2001-138279A has a diagonal joint connecting two 
links. The diagonal joint connects the two links such 
that one of the two links makes a conical revolution on 
the diagonal joint. Each of the two adjacent links 
connected by the diagonal joint revolves about a 
rotation axis inclined at a predetermined angle to its 
axis . 

For example, an articulated manipulator comprises a 
plurality of links arranged in series, and a plurality 
of joints rotatably connecting the adjacent links, 
respectively. The joints include coaxial joints and 
diagonal joints. The coaxial joint connects the adjacent 
links so that the adjacent links are able to turn about 
a rotation axis aligned with their axes. The diagonal 
joint connects the adjacent links such that one of the 
two adjacent links is able to make a conical revolution 
relative to the other about a rotation axis inclined at 



an angle to its axis. 

The articulated manipulator moves a terminal device 
connected to its terminal end along a predetermined path. 
The motion of the terminal device needs to be converted 
into the respective turning motions of the links to move 
the terminal device by the articulated manipulator; that 
is, the rotation angles of the links must be determined 
by inverse transformation on the basis of a position at 
which the terminal device is to be positioned and an 
orientation in which the terminal device is to be set. 

According to the prior art disclosed in JP56- 
163624A, the inverse transformation is impossible unless 
the articulated manipulator has seven joints connecting 
the links, namely, a coaxial joint, a diagonal joint, a 
coaxial joint, a diagonal joint, a coaxial joint, a 
diagonal joint and a coaxial joint arranged in that 
order. In the case of using this prior art, analytical 
solution cannot be obtained through inverse 
transformation for an articulated manipulator having 
less than seven joints. Therefore, there has been no 
articulated manipulator having six or less joints. 

If there is an articulated manipulator having six 
joints, con^licated simultaneous equations must be 
solved for inverse transformation. It is difficult to 
obtain analytical solutions even if a computer capable 
of executing a formula manipulation program is used for 
solving the con^licated simultaneous equations. 
Therefore, the rotation angles of the links of an 
articulated manipulator having six or less joints must 
be determined by a convergence operation, such as an 
operation using the Newton-Raphson formula. The rotation 
angles of the links cannot be determined quickly by the 
convergence operation . 

Technique disclosed in JP2001-138279A determines 
rotation angles of the links by an interpolatory 
approximation method. This method determines a 
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representative point and orientation of the terminal end 
of the articulated manipulator by an analytical direct 
transformation after the rotation angles of the links 
are determined^ and stores rotation angles of the links 
5 with the terminal device located at a plurality of 
representative points in a database beforehand. Inverse 
transformation determines rotation angles of the links 
by interpolatory approximation using data included in 
the database. The terminal end of an articulated 
10 manipulator having less than seven joints cannot 
accurately be positioned and oriented by operating the 
articulated manipulator on the basis of this method 
because the rotation angles are approximate values . 

Fig. 10 shows a part of an articulated manipulator 
15 1 whose location is controlled by interpolatory 
approximation. Generally, the articulated manipulator 1 
stores rotation angles of its links when a terminal 
device 10 is located at representative points. For 
example, to move the terminal device 10 from a first 
20 representative point A to a second representative point 
B, the articulated manipulator 1 reads the rotation 
angles of the links with the terminal device 10 at the 
representative point A, and those of the links with the 
terminal device 10 at the representative point B from 
25 the database. Then, the articulated manipulator 1 
carries out interpolatory calculations using the 
rotation angles of the links with the terminal device 10 
at the representative point A and those of the same with 
the terminal device 10 at the representative point B to 
30 determine interpolated rotation angles. The links are 
turned to the interpolated rotation angles to shift the 
terminal device 10 from the representative point A to 
the representative point B. 

Since the links are turned to the rotation angles 
35 deteirmined by interpolatory approximation, the terminal 
device 10 cannot accurately be located; that is, the 



t:e3nninal device 10 cannot smoothly moved along a 
prescribed path. 

There are a plurality of combinations of the 
rotation angles of the links to set the terminal device 
10 in a desired orientation at a desired position. 
However, when the rotation angles of the links are 
determined by a convergence operation or interpolatory 
approximation, only a single combination of rotation 
angles can be determined and hence an optimiom 
combination of rotation angles of the links cannot be 
determined . 

The rotation angles of the links of the articulated 
manipulator having six or less joints cannot 
analytically be determined in locating the terminal 
device 10 in a desired orientation at a desired position 
and, consequently, the terminal device 10 cannot c[uickly 
and accurately be located in the desired orientation at 
the desired position. Moreover, a plurality of 

combinations of the rotation angles of the links cannot 
be determined. 

SUMMARY OF THE INVENTION 

Accordingly, it is an object of the present 
invention to provide a positioning data calculating 
procedure and a positioning data calculating apparatus 
capable of analytically determining angles of the links 
of an articulated manipulator to locate an object in a 
desired orientation at a desired position. 

According to a first aspect of the present 
invention, a positioning data calculating procedure for 
calculating relative rotation angles for first to sixth 
links arranged in series and included in an articulated 
manipulator including coaxial joints each connecting the 
adjacent ones of the first to the sixth link so that the 
adjacent links are able to turn about a rotation axis 
aligned with their axes, and diagonal joints each 
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connecting the adjacent ones of the first to the sixth 
link so that the adjacent links are able to revolve 
about a rotation axis inclined to their axes, in which 
the sixth link is attached rotatably to a predetermined 
5 object, and a rotation axis about which the sixth link 
and the object turn, a rotation axis about which the 
fifth and the sixth link turn and a rotation axis about 
which the fourth and the fifth link turn intersect each 
other at a triaxial intersection point comprises: a data 
10 entering step of entering data on position and 
orientation of the object in a reference coordinate 
system with an x-axis, a y-axis and a z-axis 
orthogonally intersecting each other and fixed relative 
to the first link; a triaxial intersection point 
15 coordinate calculating step of calculating x-, y- and z- 
coordinate of the triaxial intersection point in the 
reference coordinate system on the basis of the entered 
data on the position and orientation of the object; a 
first-to-third rotation angle calculating step of 
20 calculating first to third rotation angles by solving 
coordinate expressions including an x-coordinate 
expression representing the x-coordinate of the triaxial 
intersection point, a yz addition coordinate expression 
representing the sum of the y- and the z -coordinate of 
25 the triaxial intersection point, and a yz subtraction 
coordinate expression representing the remainder of 
subtraction of the z -coordinate from the y-coordinate of 
the triaxial intersection point, and including a first 
rotation angle corresponding to a rotation angle through 
30 which the second link is turned relative to the first 
link, a second rotation angle corresponding to a 
rotation angle through which the third link is turned 
relative to the second link, and a third rotation angle 
corresponding to a rotation angle through which the 
35 fourth link is turned relative to the third link as 
variables; and a fourth-to-sixth angle calculating step 



of calculating a fourth rotation angle through which the 
fifth link is turned relative to the fourth link, a 
fifth rotation angle through which the sixth link is 
turned relative to the fifth link, and a sixth rotation 
angle through which the object is turned relative to the 
sixth link on the basis of the first to the third 
rotation angle and the orientation of the object. 

According to the present invention, the articulated 
manipulator as an object of orientation control has the 
triaxial intersection point where the rotation axis 
about which the object and the sixth link turn, the 
rotation axis about which the sixth and the fifth link 
turn, and the rotation axis about which the fifth and 
the fourth link turn are coincident. Therefore the 
coordinates of the triaxial intersection point can 
uniquely be determined when the position and orientation 
of the object is determined. The object may be, for 
example, a base or a terminal device. 

When the data on the position and orientation of 
the object is entered, the x-, the y- and the z- 
coordinate of the triaxial intersection point can be 
determined. The coordinate expressions including the x- 
coordinate expression, the yz addition coordinate 
expression and the yz subtraction coordinate expression 
are solved. The use of the yz addition coordinate 
expression and the yz subtraction coordinate expression 
encQ^les the analytical determination of the first to the 
third angle included in the coordinate expressions. When 
the first to the third angle are determined by the 
first-to-third angle calculating step, the fourth to the 
sixth angle can analytically be determined by the 
fourth-to-sixth angle calculating step. 

Thus, the first to the sixth angle can quickly and 
accurately be determined through the analytical solution 
of the expressions . All the possible combinations of the 
angles can be obtained in moving the object to a desired 
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position . 

According to a second aspect of the present 
invention, a rotation angle calculating procedure for 
calculating relative rotation angles for first to sixth 
5 links arranged in series and included in an articulated 
manipulator including coaxial joints each connecting the 
adjacent ones of the first to the sixth link so that the 
adjacent links are able to turn about a rotation axis 
aligned with their axes, and diagonal joints each 
10 connecting the adjacent ones of the first to the sixth 
link so that the adjacent links are able to revolve 
about a rotation axis inclined to their axes, in which 
the sixth link is attached rotatably to a predetermined 
object, and a rotation axis about which the fifth and 
15 the sixth link turn, and a rotation axis about which the 
fourth and the fifth link turn intersect each other at a 
biaxial intersection point comprises: a data entering 
step of entering data on a position and orientation of 
the object in a reference coordinate system with an x- 
20 axis, a y-axis and a z-axis orthogonally intersecting 
each other and fixed relative to the first link; a 
biaxial intersection point coordinate calculating step 
of calculating x-, y- and z-coordinate of the biaxial 
intersection point in the reference coordinate system on 
25 the basis of the entered data on the position and 
orientation of the object; a first-to-third angle 
calculating step of calculating first to third angles by 
solving coordinate expressions including an x-coordinate 
expression representing the x-coordinate of the biaxial 
30 intersection point, a yz addition coordinate expression 
representing the sum of the y- and the z-coordinate of 
the biaxial intersection point, and a yz subtraction 
coordinate expression representing the remainder of 
subtraction of the z-coordinate from the y-coordinate of 
35 the biaxial intersection point, and including a first 
angle corresponding to a rotation angle through which 
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the second link is turned relative to the first link, a 
second angle corresponding to a rotation angle through 
which the third link is turned relative to the second 
link, and a third angle corresponding to a rotation 
angle through which the fourth link is turned relative 
to the third link as variables; and a fourth-and-f if th 
angle calculating step of calculating a fourth rotation 
angle through which the fifth link is turned relative to 
the fourth link, and a fifth rotation angle through 
which the sixth link is turned relative to the fifth 
link, on the basis of the first to the third rotation 
angle and the orientation of the object. 

According to the present invention, the articulated 
manipulator as an object of orientation control has the 
biaxial intersection point where the rotation axis about 
which the sixth and the fifth link turn, and the 
rotation axis about which the fifth and the fourth turn 
are coincident. Therefore the coordinates of the biaxial 
intersection point can uniquely be determined when the 
position and orientation of the object is determined. 
The object may be, for example, a base or a terminal 
device. 

When the data on the position and orientation of 
the object is entered, the x-, the y- and the z- 
coordinate of the biaxial intersection point can be 
determined. The coordinate expressions including the x- 
coordinate expression, the yz addition coordinate 
expression and the yz subtraction coordinate expression 
are solved. The use of the yz addition coordinate 
expression and the yz subtraction coordinate expression 
enables the analytical determination of the first to the 
third angle included in the coordinate expressions • When 
the first to the third angle are determined by the 
first- to- third angle calculating step, the fourth and 
the fifth angle can analytically be determined by the 
fourth-and-f if th angle calculating step. 



Thus, the first to the fifth angle can quickly and 
accurately be determined through the analytical solution 
of the expressions. All the possible combinations of the 
angles can be obtained to move the object to a desired 
position. 

According to a third aspect of the present 
invention, a positioning data calculating apparatus for 
calculating relative rotation angles of first to sixth 
links arranged in series and included in an articulated 
manipulator including coaxial joints each connecting the 
adjacent ones of the first to the sixth link so that the 
adjacent links are able to turn about a rotation axis 
aligned with their axes, and diagonal joints each 
connecting the adjacent ones of the first to the sixth 
link so that the adjacent links are able to revolve 
about a rotation axis inclined to their axes, in which 
the sixth link is attached rotatably to a predetermined 
object, and a rotation axis about which the sixth link 
and the object turn, a rotation axis about which the 
fifth and the sixth link turn and a rotation axis about 
which the fourth and the fifth link turn intersect each 
other at a triaxial intersection point comprises: a data 
entering means for entering data on a position and 
orientation of the object in a reference coordinate 
system with an x-axis, a y-axis and a z-axis 
orthogonally intersecting each other and fixed relative 
to the first link; a calculating means for calculating 
an X-, a y- and z-coordinate of the triaxial 
intersection point in the reference coordinate system on 
the basis of the entered data on the position and 
orientation of the object, determining first to third 
rotation angles by solving coordinate expressions 
including an x-coordinate expression representing the x- 
coordinate of the triaxial intersection point, a yz 
addition coordinate expression representing the sum of 
the y- and the z-coordinate of the triaxial intersection 
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point, and a yz subtraction coordinate expression 
representing the remainder of svibtraction of the z- 
coordinate from the y-coordinate of the triaxial 
intersection point, and including a first angle 
corresponding to a rotation angle through which the 
second link is turned relative to the first link, a 
second angle corresponding to a rotation angle through 
which the third link is turned relative to the second 
link, and a third angle corresponding to a rotation 
angle through which the fourth link is turned relative 
to the third link as variables, and calculating a fourth 
rotation angle through which the fifth link is turned 
relative to the fourth link, a fifth rotation angle 
through which the sixth link is turned relative to the 
fifth link, and a sixth rotation angle through which the 
object is turned relative to the sixth link on the basis 
of the first to the third rotation angle and the 
orientation of the object; and an output means for 
providing calculated data calculated by the calculating 
means . 

According to the present invention, the articulated 
manipulator as an object of orientation control has the 
triaxial intersection point where the rotation axis 
about which the object and the sixth link turn, the 
rotation axis cJbout which the sixth and the fifth link 
turn, and the rotation axis about which the fifth and 
the fourth link turn are coincident. Therefore the 
coordinates of the triaxial intersection point can 
uniquely be determined when the position and orientation 
of the object is determined. The object may be, for 
example, a base or a terminal device. 

When the data on the position and orientation of 
the object is entered by the data entering means, the x-, 
the y- and the z-coordinate of the triaxial intersection 
point can be determined. The calculating means solves 
the coordinate expressions including the x-coordinate 



expression, the yz addition coordinate expression and 
the yz subtraction coordinate expression. The first to 
the third angle included in the coordinate expressions 
can analytically be determined by using the yz addition 
coordinate expression and the yz subtraction coordinate 
expression. When the first to the third angle are 
determined, the fourth to the sixth angle can 
analytically be determined on the bass of the first to 
the third angle. The calculating means gives the first 
to the sixth angle to the output means, and the output 
means delivers the calculated results. 

Thus, the first to the sixth angle can quickly and 
accurately be determined through the analytical solution 
of the expressions in locating the object in a desired 
orientation at a desired position. All the possible 
combinations of the angles can be obtained in moving the 
object to a desired position. 

According to a fourth aspect of the present 
invention, a positioning data calculating apparatus for 
calculating relative rotation angles for first to sixth 
links arranged in series and included in an articulated 
manipulator including coaxial joints each connecting the 
adjacent ones of the first to the sixth link so that the 
adjacent links are able to turn about a rotation axis 
aligned with their axes, and diagonal joints each 
connecting the adjacent ones of the first to the sixth 
link so that the adjacent links are able to revolve 
about a rotation axis inclined to their axes, in which 
the sixth link is attached rotatably to a predetermined 
object, and a rotation axis about which the fifth link 
and the sixth link turn, and a rotation axis about which 
the fourth and the fifth link turn intersect each other 
at a biaxial intersection point comprise: a data 
entering means for entering data on a position and 
orientation of the object in a reference coordinate 
system with an x-axis, a y-axis and a z-axis 
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orthogonally intersecting each other and fixed relative 
to the first link; a calculating means for calculating 
y- and z-coordinate of the biaxial intersection 
point in the reference coordinate system on the basis of 
the entered data on the position and orientation of the 
object, determining first to third rotation angles by 
solving coordinate expressions including an x-coordinate 
expression representing the x-coordinate of the biaxial 
intersection point, a yz addition coordinate expression 
representing the s\am of the y- and the z-coordinate of 
the biaxial intersection point, and a yz subtraction 
coordinate expression representing the remainder of 
subtraction of the z-coordinate from the y-coordinate of 
the biaxial intersection point, and including a first 
angle corresponding to a rotation angle through which 
the second link is turned relative to the first link, a 
second angle corresponding to a rotation angle through 
which the third link is turned relative to the second 
link, and a third angle corresponding to a rotation 
angle through which the fourth link is turned relative 
to the third link as variables, and calculating a fourth 
rotation angle through which the fifth link is turned 
relative to the fourth link, and a fifth rotation angle 
through which the sixth link is turned relative to the 
fifth link on the basis of the first to the third 
rotation angle and the orientation of the object; and an 
output means for providing calculated data calculated by 
the calculating means. 

According to the present invention, the articulated 
manipulator as an object of orientation control has the 
biaxial intersection point where the rotation axis about 
which the sixth link and the fifth link turn, and the 
rotation axis about which the fifth and the fourth link 
turn are coincident. Therefore the coordinates of the 
biaxial intersection point can uniquely be determined 
when the position and orientation of the object is 
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detejmiined. The object may be, for example, a base or a 
termi nal devi ce . 

^en the data on the position and orientation of 
the object is entered by the data entering means, the x-, 
the y- and the z-coordinate of the biaxial intersection 
point can be determined by the calculating means. The 
calculating means solves the coordinate expressions 
including the x-coordinate expression, the yz addition 
coordinate expression and the yz stabtraction coordinate 
expression. The first to the third angle included in the 
coordinate expressions can analytically be determined by 
using the yz addition coordinate expression and the yz 
subtraction coordinate expression. When the first to the 
third angle are determined, the fourth and the fifth 
angle can analytically be determined on the bass of the 
first to the third angle. The calculating means gives 
the first to the fifth angle to the output means, and 
the output means provides the calculated results. 

Thus, the first to the fifth angle can quickly and 
accurately be determined through the analytical solution 
of the expressions in locating the object in a desired 
orientation at a desired position. All the possible 
combinations of the angles can be obtained to move the 
object to a desired position. 

According to a fifth aspect of the present 
invention, an articulated manipulator comprises: first 
to sixth links arranged in series; coaxial joints each 
connecting the adjacent ones of the first to the sixth 
link so that the adjacent links are able to turn about a 
rotation axis aligned with their axes; and diagonal 
joints each connecting the adjacent ones of the first to 
the sixth link so that the adjacent links are eJDle to 
revolve about a rotation axis inclined to their axes; 

wherein the sixth link is attached rotatably to a 
predetermined object so that the object is cJDle to turn 
about the axis of the sixth link, the fifth and the 
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sixth link are connected by the diagonal joint, the 
fourth and the fifth link are connected by the coaxial 
joint, the third and the fourth link are connected by 
the diagonal joint, the second and the third link are 
connected by the coaxial joint, and the first and the 
second link are connected by the diagonal joint. 

According to the present invention, a rotation axis 
about which the object and the sixth link turn, a 
rotation axis about which the sixth and the fifth link 
turn, and a rotation axis about which the fifth and the 
fourth link turn are coincident at a triaxial 
intersection point. Therefore the coordinates of the 
triaxial intersection point can uniquely be deteannined 
by an orientation controller when the position and 
orientation of the object is determined. The orientation 
controller is able to determine analytically the first 
to the sixth angle for the links for locating the object 
in a desired orientation at a desired position. 

When at least the rotation axis about which the two 
links connected by the diagonal joint among the joints 
connecting the first to the third link turn inclines at 
an angle of 45° to the axes of the two links connected by 
the diagonal joint, the orientation controller is able 
to determine the angle by using simple expressions. Thus, 
the orientation controller is able to determine the 
first to the sixth angle in a shorter time. 

According to a sixth aspect of the present 
invention, an articulated manipulator comprises: first 
to sixth links arranged in series; coaxial joints each 
connecting the adjacent ones of the first to the sixth 
link so that the adjacent links are able to turn about a 
rotation axis aligned with their axes; and diagonal 
joints each connecting the adjacent ones of the first to 
the sixth link so that the adjacent links are able to 
revolve about a rotation axis inclined to their axes; 

wherein the sixth link is fixedly connected to a 
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predetermined object, the fifth and the sixth link are 
connected by the diagonal joint, the fourth and the 
fifth link are connected by the coaxial joint, the third 
and the fourth link are connected by the diagonal joint, 
the second and the third link are connected by the 
coaxial joint, and the first and the second link are 
connected by the diagonal joint. 

According to the present invention, a rotation axis 
about which the fifth and the sixth link turn, and a 
rotation axis about which the fifth and the fourth link 
turn are coincident at a biaxial intersection point. 
Therefore the coordinates of the biaxial intersection 
point can uniquely be determined by an orientation 
controller when the position and orientation of the 
object is determined. The orientation controller is able 
to determine analytically the first to the fifth angle 
for the links for locating the object in a desired 
orientation at a desired position. 

When at least the rotation axis about which the two 
links connected by the diagonal joint among the joints 
connecting the first to the third link turn inclines at 
an angle of 45** to the axes of the two links connected by 
the diagonal joint, the orientation controller is able 
to determine the angle by using simple expressions. Thus, 
the orientation controller is able to determine the 
first to the sixth angle in a shorter time. 

BRIEF DESCRIPTION OF THE DRAWINGS 
The above and other objects, features and 
advantages of the present invention will become more 
apparent from the following description taken in 
connection with the accompanying drawings, in which: 

Fig. 1 is a schematic front elevation of an 
articulated manipulator in a first embodiment according 
to the present invention; 

Figs. 2(1) to 2(8) are views of the articulated 
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manipulator shown in Fig. 1 in different shapes, 
respectively, formed by orientation control operations 
executed by a positioning arithmetic unit; 

Fig. 3 is diagrammatic view of assistance in 
5 explaining an orientation control operation to be 
carried out by the positioning arithmetic unit to 
control the articulated manipulator in moving a terminal 
device; 

Fig. 4 is a flow chart of a positioning data 
10 calculating procedure to be executed by the positioning 
arithmetic unit; 

Fig. 5 is a flow chart of a positioning data 
calculating procedure in a preferred embodiment 
according to the present invention; 
15 Fig. 6 is a typical view of a true model of an 

articulated manipulator according to the present 
invention ; 

Fig. 7 is a typical view of an inverted model in 
inverse relation to the true model ; 
20 Fig. 8 is a typical view of an equivalent model 

formed by replacing one of the joints of an articulated 
manipulator represented by the inverted model shown in 
Fig. 7 with an equivalent joint; 

Fig. 9 is a typical view of an articulated 
25 manipulator in a second embodiment according to the 
present invention; and 

Fig. 10 is a diagrammatic view of assistance in 
explaining an orientation control operation for 
controlling the orientation of a conventional 
30 articulated manipulator. 

DESCRIPTION OF THE PREFERRED EMBODIMENTS 
Referring to Fig. 1, an articulated manipulator 20 
in a first embodiment according to the present invention 
35 has an arm assembly formed by connecting a plurality of 
links in series by joints. The joints include coaxial 
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joints and diagonal joints. Each coaxial joint connects 
the adjacent links so as to be turnable about a rotation 
axis aligned with the respective axes of the adjacent 
links. Each diagonal joint connects the two adjacent 
links such that the two adjacent links are able to make 
a conical revolution about a rotation axis inclined to 
the respective axes of the two adjacent links. In this 
specification, the term ^^conical revolution" signifies 
the revolution of one of two adjacent links connected by 
a joint on the joint about a rotation axis relative to 
the other on an imaginary cone having its tip on the 
joint, and the term ^^rotation" signifies angular 
displacements including those through angles not greater 
than 360"*. The articulated manipulator thus formed by 
assembling the links, the coaxial joints and the 
diagonal joints is capable of positioning a terminal 
device in a three-dimensional space by turning the links 
so that the articulated manipulator twists and turns 
like a snake. Thus, the articulated manipulator of the 
present invention is capable of satisfactorily operating 
in complicated facilities in which the articulated 
manipulator needs to operate along complicated work 
paths . 

The articulated manipulator of the present 
invention is used as an industrial robot. A desired 
tezminal device, i.e., an end effector, can be attached 
to the free end of the articulated manipulator, the 
terminal device can be positioned at a desired position, 
and can operate for necessary work in a narrow space. 
The articulated manipulator can be used in many tasks, 
such as material handling, sealing, painting, arc 
welding and such. 

Referring to Fig. 1, an articulated manipulator 20 
in a first embodiment according to the present invention 
is a six-degree of freedom articulated manipulator 
including six links, namely, a first link cl , a second 
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link c2, a third link c3, a fourth link c4 , a fifth link 
c5 and a sixth link a6, and six joints / namely, a first 
joint dl, a second joint d2 , a third joint d3, a fourth 
joint d4, a fifth joint d5 and a sixth joint d6, 
connecting the adjacent links. The joints dl to d6 
connects the links cl to c6 to form an arm assembly. The 
three joints dl , d3 and d5 are coaxial joints, and the 
three joints d2, d4 and d6 are diagonal joints. Each of 
the diagonal joints d2, d4 and d6 connects the adjacent 
links such that the two adjacent links are able to 
revolve relative to each other about a rotation axis 
inclined at an angle of 45^ to the respective axes of the 
adjacent links. 

The links cl to c6 are arranged in series in that 
order from a base end outward. A terminal device 22 is 
connected to the free end of the sixth link c6. The 
links cl to c6 can coaxially be extended in a straight 
structure as shown in Fig. 1. 

The coaxial joint dl connects an inner end 23 of 
the first link cl to a base 21. The base 21 may fixedly 
be installed at a predetermined position or may be 
movable. The first link cl is able to rotate about a 
rotation axis LI coaxial with its axis relative to the 
base 21. The diagonal joint d2 connects an outer end 24 
of the first link cl to the second link c2 . 

The second link c2 is able to make a conical 
revolution relative to the first link cl on the diagonal 
joint d2 about an inclined rotation axis L2 inclined at 
an angle of 45^ to the axis of the second link c2. The 
coaxial joint d3 connects an outer end 25 of the second 
link c2 opposite the first link cl to the third link c3. 

The second link c2 and the third link c3 are able 
to turn about a rotation axis L3 aligned with their axes. 
The diagonal joint d4 connects an outer end 26 of the 
third link c3 opposite the second link c2 to the fourth 
link c4 . 
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The third link c3 and the fourth link c4 are able 
to make a conical revolution relative to each other on 
the diagonal joint d4 about an inclined rotation axis L4 
inclined at an angle of 45® to the respective axes of the 
5 third link c3 and the fourth link c4 . The coaxial joint 
d5 connects an outer end 27 of the fourth link c4 
opposite the third link c3 to the fifth link c5. 

The fourth link c4 and the fifth link c5 are able 
to rotate about a rotation axis L5 aligned with the 

10 respective axes of the fourth link c4 and the fifth link 
c5. The diagonal joint d6 connects an outer end 28 of 
the fifth link c5 opposite the fourth link c4 to the 
sixth link c6. 

The fifth link c5 and the sixth link c6 are able to 

15 make a conical revolution relative to each other on the 
diagonal joint d6 about an inclined rotation eocis L6 
inclined at an angle of 45® to the respective axes of the 
fifth link c5 and the sixth link c6. The terminal device 
22 is connected to an outer end of the sixth link c6 

20 opposite the fifth link c5. The terminal device 22 may 
be any suited^le device, such as a material handling 
device capable of gripping parts . 

The coaxial joints and the diagonal joints are 
arranged alternately in the arm assembly formed by 

25 connecting the links cl to c6 in series . The arm 
assembly can straight be extended with all the axes of 
the links cl to c6 in alignment. The articulated 
manipulator 20 has a triaxial intersection point where 
the rotation axis LI about which the base 21 and the 

30 first link cl turn, the second rotation axis Ii2 about 
which the first link cl and the second link c2 revolve, 
and the rotation axis L3 about which the second link c2 
and the third link c3 turn are coincident. 

Rotary motors are inco3rporated into the links cl to 

35 c6 to drive the links cl to c6 for rotation. The links 
cl to c6 are hollow members respectively having bores. 
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Power lines, signal lines and tubes are passed through 
the bores of the links cl to c6 to supply power to the 
rotary motors, to send control signals to the rotary 
motors and to supply compressed air to the terminal 
device 22. 

A conventional rotating mechanism may be employed 
for turning each of the links cl to c6 about the 
rotation axis. For example, the articulated manipulator 
20 may be provided for turning each of the links cl to 
c6 with a rotating mechanism including bearings 
supporting the adjacent links for turning about the 
rotation axis, and a hollow waving gear mechanism, such 
as a Harmonic drive®. The waving gear mechanism has an 
input member and an output member, and the input and the 
output member rotate relative to each other. When the 
waving gear mechanism is employed, one of the adjacent 
links is connected to the input member, and the other is 
connected to the output member. When the input member is 
driven for rotation by the rotary motor, the input and 
the output member rotate relative to each other to turn 
the adjacent links relative to each other. The adjacent 
links can be turned relative to each other by providing 
the links cl to c6 with such rotating mechanisms. The 
use of the hollow waving gear mechanism (Harmonic 
drive®) enables the adjacent links to turn relative to 
each other with the power lines and signal lines 
extended through the links cl to c6. The articulated 
manipulator 20 can be suited for use in a dusty, 
explosive, h\imid working environment by covering the 
articulated manipulator 20 entirely or covering the 
power lines and signal lines extended through the bores 
of the links cl to c6 with a cover formed of a 
waterproof, heat-resistant, shock-resistant material. 

As shown in Fig. 1, the articulated manipulator 20 
is provided with a positioning arithmetic unit 30 for 
calculating angles of the links cl to c6 relative to 



each other. The positioning arithmetic unit 30 

calculates relative rotation angles 0i to 06 through 
which the links cl to c6 are to be turned, respectively, 
to locate the terminal device 22 in a desired 
orientation at a desired position. 

The positioning arithmetic unit 30 includes an 
input device 31, a calculating device 32 and an output 
device 33. The input device 31 gives the calculating 
device 32 data on a position and an orientation in which 
the terminal device 22 is to be located in a reference 
coordinate system. The calculating device 32 calculates 
relative rotation angles 9i to 06 through which the links 
cl to c6 are to be turned to locate the terminal device 
22 in the desired orientation at the desired position on 
the basis of the data given thereto by the input device 
31 and the dimensions of the articulated manipulator 20. 
The output device 33 provides power signals and control 
signals for turning the links cl to c6 on the basis of 
calculated data provided by the calculating device 32 . 
Consequently, the links cl to c6 are turned according to 
the calculated data. 

The positioning arithmetic unit 30 is, for example, 
a computer. The input device 31 includes a pointing 
device, such as a keyboard or a mouse, and a teaching 
pendant controller to be operated by the operator for 
the direct control of the articulated manipulator 20 by 
the operator. The input device 31 may be capable of 
entering data on a position and orientation of the end 
effector provided by an external device connected to the 
positioning arithmetic unit 30. The output device 33 
generates control signals for controlling the operation 
of the drive motors on the basis of the calculated data, 
and gives the control signals to the drive motors. The 
output device 33 may be, for example, a drive circuit. 
The positioning arithmetic unit 30 may be either built 
in the articulated manipulator 20 or installed outside 
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the articulated manipulator 20, 

The calculating device 32 includes a central 
processing unit (CPU) that executes arithmetic programs. 
The arithmetic programs may be stored beforehand in the 
CPU or may be stored in a storage device and read by the 
CPU. The arithmetic programs prescribe calculating 
methods, which will be described later. 

Figs. 2(1) to 2(8) are views of the articulated 
manipulator 20 in different shapes, respectively, formed 
by orientation control operations executed by the 
positioning arithmetic unit 30. The positioning 

arithmetic unit 30 calculates values of the rotation 
angles 9i to Be through which the links cl to c6 must be 
turned, respectively, to locate the terminal device in a 
desired orientation at a desired position by using 
analytical expressions. There are eight combinations of 
the rotation angles 9i to 06 for locating the teiminal 
device 22 held on the six-axis articulated manipulator 
20 in a desired orientation at a desired position. The 
arithmetic unit 30 is able to provide the eight 
combinations of the angles 9i to Be simultaneously by 
calculating the angles Bi to Be using the analytical 
expressions. The terminal device 22 can be located in a 
desired orientation at a desired position by bending the 
articulated manipulator 20 in any one the eight shapes 
shown in Figs. 2(1) to 2(8). One of the eight 
combinations of the angles 6i to Be through which the 
links cl to c6 are to be turned is selected taking into 
consideration energy cost and obstacles around the 
articulated manipulator 20. 

Fig. 3 is diagrammatic view of assistance in 
explaining an orientation control operation to be 
carried out by the positioning arithmetic unit 30 to 
control the articulated manipulator 20 in moving the 
terminal device 20. When it is desired to move the 
terminal device 22 from a first representative point A 
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to a second representative point B, intermediate points 
Ul to U3 that is to be passed by the terminal device 22 
when the terminal device 22 moves from the first 
representative point A to the second representative 
point B are determined. Rotation angles through which 
the links cl to c6 are to be turned to locate the 
terminal device 22 at the intermediate points Ul to U3 
are calculated to move the terminal device 22 smoothly 
along a specified path including the inteirmediate points 
Ul to U3. 

The positioning arithmetic unit 30 does not need to 
perform the convergence operation, which must be 
performed by the conventional articulated manipulator, 
to determine the rotation angles for the links cl to c6 . 
Therefore, the rotation angles can quickly be determined, 
the calculating device 32 does not need to have a high 
data processing ability, and the rotation angles for the 
links can be calculated even during the movement of the 
terminal device 22. The rotation angles for the links cl 
to c6 at the representative points A and B do not need 
to stored in a database, the storage capacity of the CPU 
may be small . 

Referring to Fig. 4 showing a flow chart of a 
positioning data calculating procedure to be executed by 
the positioning arithmetic unit 30, data on the 
articulated manipulator 20 to be controlled including 
the dimensions of the links, and the types and 
characteristics of the joints is given in step si. In 
step s2 , data on the position and orientation of an 
object to be moved by the articulated manipulator 20 is 
acquired. In this case, the object is the terminal 
device 22 attached to the free end of the sixth link c6, 
and the data represents the orientation and position of 
the terminal device 22 in the fixed coordinate system. 
Then, in step s3, the coordinates of the triaxial 
intersection point, where the rotation axis LI about 
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which the base 21 and the first link cl turn, the second 
rotation axis L2 about which the first link cl and the 
second link c2 revolve, and the rotation axis L3 about 
which the second link c2 and the third link c3 turn are 
coincident, are deteinnined. The coordinates of the 
triaxial intersection point are uniquely dependent on 
the orientation and the position of the object. 
Therefore, the coordinates of the triaxial intersection 
point can be determined on the basis of the orientation 
and position of the object determined in step s2 . Then, 
in step s4, coordinate expressions expressing the 
coordinates of the triaxial intersection point are 
produced using, as variables, the first to the third 
angle, i.e., relative rotation angles of turning of the 
three links about the three rotation axes other than the 
three rotation axes intersecting at the trisixial 
intersection point. The coordinate expressions are an x-, 
a y- and a z-coordinate expression respectively 
expressing the x-, the y- and the z-coordinate of the 
triaxial intersection point. Then, a yz addition 
coordinate expression representing the sum of the y- and 
the z-coordinate of the triaxial intersection point, and 
a yz subtraction coordinate expression representing the 
remainder of subtraction of the z-coordinate from the y- 
coordinate of the triaxial intersection point are 
produced. Then, in step s5, the first to the third 
angles are calculated by using the x-coordinate 
expression, the yz addition coordinate expression and 
the yz subtraction coordinate expression produced in 
step s4 . Then, the fourth to the sixth angle are 
determined on the basis of the first to the third angle. 
After the rotation angles for the links cl to c6 have 
been determined, the positioning data calculating 
procedure is ended in step s6. 

To facilitate the determination of the rotation 
angles, suppose that the articulated manipulator 20 
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shown in Fig. 1 is a true model, an inverted model is in 
inverse relation to the true model with respect to the 
z-axis, and an equivalent model is equivalent to the 
inverted model and has joints including one joint 
different from that of the inverted model. The rotation 
angles for the links can more easily be determined after 
transforming the true model into the inverted model and 
the equivalent model . 

Referring to Fig. 5 showing a flow chart of a 
positioning data calculating procedure for calculating 
positioning data for the positioning control of the 
articulated manipulator 20 shown in Fig. 1, data, on the 
articulated manipulator 20 as the true model to be 
controlled, including the dimensions of the links, and 
the types and characteristics of the joints necessary 
for calculating rotation angles for the links is given 
in step sll. In step sl2, data on the position and 
orientation of the terminal device with respect to the 
base 21 of the true model is acquired. In step sl3, a 
coordinate system and a position for the true model are 
transformed into those for the inverted model. The 
position and orientation of the base 21 with respect to 
the terminal device 22 of the inverted model are 
calculated. Then, in step sl4, the position of the 
triaxial intersection point in the inverted model is 
determined on the basis of the position and orientation 
of the base 21 in the inverted model. In step sl5, 
coordinate expressions expressing the coordinates of the 
triaxial intersection point in the equivalent model are 
produced using, as variables, the first to the third 
angle, i.e., relative rotation angles of turning of the 
three links about the three rotation axes other than the 
three rotation axes intersecting at the triaxial 
intersection point. More concretely, an x-, a y- and a 
z-coordinate expression respectively expressing the x-, 
the y- and the z-coordinate of the triaxial intersection 
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point in the equivalent model are produced. Then a yz 
addition coordinate expression representing the sum of 
the y- and the z-coordinate of the triaxial intersection 
point, and a yz sxjbtraction coordinate expression 
5 representing the remainder of sxabtraction of the z- 
coordinate from the y-coordinate of the triaxial 
intersection point are produced. Then, in step sl6, the 
first to the third angles for the equivalent model are 
calculated on the basis of the position of the triaxial 

10 intersection point in the inverted model determined in 
step sl4, and the x-coordinate expression, the yz 
addition coordinate expression and the yz subtraction 
coordinate expression produced in step sl5. Then, in 
step sl7, the first to the third angles for the 

15 equivalent model detezmined in step si 6 are converted 
into the first to the third angle for the inverted model. 
Then, in step sl8, the fourth to the sixth angle are 
determined on the basis of the first to the third angle. 
After converting the first to the sixth angle for the 

20 inverted model determined in steps sl7 and sl8 into the 
first to the sixth angle for the true model, the 
positioning data calculating procedure is ended in step 
s20. 

Fig. 6 shows a true model modeling the articulated 
25 manipulator 20 of the present invention. The articulated 
manipulator 20 has a reference coordinate system Erb 
fixedly attached to the base 21. The reference 

coordinate system Srb has a reference x-, a reference y- 
and a reference z-axis orthogonally intersecting each 
30 other at an origin. 

Body-attached coordinate systems are fixedly 
attached to the links cl to c6 and the terminal device 
22, respectively. The body-attached coordinate systems 
are three-axis orthogonal coordinate system having their 
35 origins at the representative points of the links cl to 
c6 and the terifninal device 22, respectively. Each of the 



body-attached coordinate systems has a body-attached x-, 
a body-attached y- and a body-attached z-axis 
orthogonally intersecting each other and coincident at 
the origin. 

In the true model shown in Fig. 6, the origin of 
the reference coordinate system Zrb is coincident with a 
base representative point S on an imaginary line aligned 
with the rotation axis LI aODOut which the first link cl 
and the base 21 turn relative to each other. Since the 
terminal device 22 is fixed to the sixth link c6, he 
determination of the position and orientation of the 
terminal device 22 is equivalent to the determination of 
the position and orientation of the sixth link c6. The 
position of the terminal device 22 is represented by the 
coordinates of the representative point T of the sixth 
link c6 on an imaginary line aligned with the rotation 
axis L5 abut which the fourth link c4 and the fifth link 
c5 turn relative to each other. 

A terminal coordinate system Zrt, namely, a body- 
attached coordinate system attached to the terminal 
device 22, is a three-axis orthogonal coordinate system 
having its origin coincident with the representative 
point T of the sixth link c6. The representative point T 
of the sixth link c6 move in the reference coordinate 
system Erb as the links cl to cy turn relative to each 
other . 

The position of the representative point T is 
represented by coordinates (Tx, Ty, Tz) in the reference 
coordinate system Erb. Tx is a reference x-coordinate, 
Ty is a reference y-coordinate, and Tz is a reference z- 
coordinate in the reference coordinate system Zrb. When 
the links cl to c6 connected in series and forming a 
straight arm assembly are turned relative to each other, 
the orientation of the sixth link changes and, 
consequently, the terminal coordinate system Srt turns 
relative to the reference coordinate system Zrb. The 
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orientation of the sixth link c6 is represented by 
orientation (qo, qa, qt) , where qo, qa and qt are angles 
through which the terminal coordinate system Zbt is 
turned about the reference x-, y- and z-axis, 
respectively . 

Suppose that the links cl to c6 are in a reference 
state when the links cl to c6 are extended in the 
straight arrangement, and the first link cl, the second 
link c2, the third link c3, the fourth link c4 , the 
fifth link c5 and the sixth link c6 in the reference 
state are turned through a first rotation angle 9i, a 
second rotation angle 82, a third rotation angle 63, a 
fourth rotation angle 64, a fifth rotation angle 65 and a 
sixth rotation angle Qe relative to the base 21, the 
first link cl , the second link c3, the fourth link c4 
and the fifth link c5, respectively. 

Fig. 7 is a typical view of an inverted model 
representing an inverted articulated manipulator 20A in 
inverse relation to the true model. Fig. 8 is a typical 
view of an equivalent model representing an equivalent 
articulated manipulator 2 OB formed by replacing one of 
the joints of the articulated inverted manipulator 2 OA 
represented by the inverted model shown in Fig. 7 with 
an equivalent joint. Parts of the models shown in Figs. 
7 and 8 will be designated by designations different 
from those of the parts of true model and denoted by 
reference characters different from those indicating the 
parts of the true model to facilitate understanding. 

The respective first links el, the second links e2, 
the third links e3, the fourth links e4 , the fifth links 
e5 and the sixth links e6 of the inverted and the 
equivalent model correspond to the sixth link cl, the 
fifth link c5, the fourth link c4 , the third link c3, 
the second link c2 and the first link cl of the true 
model, respectively. Thus, the first links el to the 
sixth links e6 of the inverted and the equivalent model 



correspond to the sixth link c6 to the first link cl of 
the true model, respectively. 

Similarly, joints of the inverted model, rotation 
angles through which the links el to e6 of the inverted 
model are turned, and longitudinal sizes of the links el 
to e6 of the inverted model are denoted by reference 
characters fl to f6, ql to q6 , and iO to 16 different 
from those denoting the corresponding joints, rotation 
angles and longitudinal sizes of the true model, 
respectively . 

The equivalent articulated manipulator 20B 
represented by the equivalent model differs from the 
inverted articulated manipulator 20A represented by the 
inverted model in a joint F3 connecting the third link 
e3 and the fourth link e4 . The joint F3 of the 
equivalent articulated manipulator 20B connects the 
third link eS and the fourth link e4 such that the 
respective axes of the third link eS and the fourth link 
e4 are able to turn about a rotation axis L3 
perpendicular thereto. Thus, the third link e3 and the 
fourth link e4 turn on the joint F3 in a plane including 
the axes thereof. 

In the inverted model , a reference coordinate 
system Ssb has its origin at the representative point T 
of the first link el coincident with the representative 
point T of the sixth link c6 of the true model . In the 
inverted model, a base coordinate system Sst, i.e., a 
body-attached coordinate system fixed to the base 21, 
has its origin coincident with the base representative 
point S. When the links el to e6 of the inverted model 
are extended coaxially in a straight arm assembly, the 
body X-, the body y- and the body z-axis are parallel to 
the reference x-, the reference y- and the reference z- 
axis of the reference coordinate system £sb, 
respectively. When the links el to e6 are extended 
coaxially in a straight arm assembly, the axes of the 
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links el to e6 are parallel to the reference z-axis of 
the reference coordinate system £sb and the base z-axis 
of the base coordinate system Est. A direction from the 
origin of the reference coordinate system Ssb toward the 
origin of the base coordinate system Est is a positive 
direction for the reference z-axis and the body z-axis. 

The articulated manipulator 20 in the first 
embodiment executes steps si to s6 when the terminal 
device 22 is fixed and the base 21 is movable. In the 
inverted model, the base 21 is regarded as an object, 
and rotation angles ql to q6 through which the links el 
to e6 are to be turned, respectively, to set the object 
in a desired orientation at a desired position are 
determined . 

The rotation angles Gi to Be through which the 
links cl to c6 of the articulated manipulator 20 
represented by the true model are turned to set the 
terminal device 22 in a desired orientation at a desired 
position can be determined by converting the rotation 
angles ql to q6 determined for the links el to e6 of the 
inverted model . 

Rotation angles for the links of an articulated 
manipulator having a triaxial intersection point on a 
terminal device, i.e., a movable end, can more easily be 
determined than those for the links of an articulated 
manipulator having a triaxial intersection point on a 
base, i.e., a fixed end. Therefore, the rotation angles 
Ql to 06 through which the links cl to c6 of the 
articulated manipulator 20 having the triaxial 
intersection point on the base can easily be determined 
by converting the rotation angles ql to q6 determined 
for the links el to e6 of the inverted model into those 
for the true model . 

The positioning data calculating procedure for 
calculating positioning data will be described with 
reference to a flow chart shown in Fig. 5. Preparatory 
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operatilons for determining the rotation angles 0i to Ge 
for the links cl to c6 are performed in step sll. In 
step sll, parameters of the articulated manipulator, and 
data, on the true model, including the longitudinal 
sizes HO to H6 of the links cl to c6, angles at which 
the rotation axis L2 about which the first link cl and 
the second link c2 are turned is inclined to the axes of 
the first link cl and the second link c2, the rotation 
axis L4 about which the third link c3 and the fourth 
link c4 are turned is inclined to the axes of the third 
link c3 and the fourth link c4 , and an angle at which 
the rotation axis L6 about which the fifth link c5 and 
the sixth link c6 are turned is inclined to the axes of 
the fifth link c5 and the sixth link c6, respectively, 
is entered. In this embodiment, it is supposed that the 
rotation axes Ii2, L4 and L6 are inclined at the same 
angle a to the axes of the associated links, and the 
angle a = 45°. 

After the parameters of the articulated manipulator 
and the data on the articulated manipulator have been 
determined, data on the position and orientation of the 
terminal device 22 with respect to the reference 
coordinate system Zrb of the true model is acquired in 
step sl2. More specifically, coordinates (Tx, Ty, Tz) of 
the representative point T of the sixth link c6, and the 
orientation (qo, qa, qt) of the sixth link c6 are 
acquired. 

In step sl3, a transformation matrix for 
transforming the true model into the inverted model is 
produced, and the orientation of the base 21 of the 
inverted model is determined by using the transformation 
matrix. The orientation of the base 21 of the inverted 
model is represented by angles qx, qy and qz through 
which the base coordinate system Est is turned about the 
reference x-, the reference y- and the reference z-axis, 
respectively, of the reference coordinate system Ssb. 
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After the orientation (qx, qy, qz) of the base 21 
has been determined, the position of the representative 
point S of the base 21 of the inverted model is 
determined. The position of the representative point S 
is represented by coordinates Px, Py and Pz on the 
reference x-, the reference y- and the reference z-axis 
of the reference coordinate system Ssb. 

On step sl4, the position of the triaxial 
intersection point is determined. The triaxial 

intersection point is coincident with the representative 
point p5 of the fifth link. In the articulated 
manipulator 20 shown in Fig. 1, the triaxial 
intersection point is coincident with the intersection 
of the rotation axis LS about which the fifth link eS 
and the sixth link e6 are turned and the axes of the 
fifth link e5 and the sixth link e6, and is on the joint 
connecting the fifth link e5 and the sixth link e6. A 
transformation matrix Ros for transforming a reference 
coordinate system into a body-attached coordinate system 
attached to the fifth link e5 is produced. The 
transformation matrix Ros is expressed by Expression (1) . 



Rq, =Rx[a]*Rz[qJ#Rx[-a] 

R^=Ro,*Rz[qJ 

Ro3 = Ro2 • Rx[a]* Rz[q3]» Rx[- a] 

Ro4=Ro3*Rz[q4] 

Ro5 =Ro4*Rx[a]*Rz[q5]*Rx[-a] (1) 



where Roi to Ros are transformation matrices for 
converting the reference coordinate system into the 
body-attached coordinate systems, and a is the angle at 
which the rotation axes are inclined to the axes of the 
associated links at the joints. The angle a in matrix 
Roi is the angle at which the rotation axis LI about 
which the first link el and the second link e2 are 
turned inclines to the axes of the links el and e2 , The 
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angle a in matrix R03 is the angle at which the rotation 
axis L3 about which the third link e3 and the fourth 
link e4 are turned inclines to the axes of the links e3 
and e4 . The angle a in matrix Ros is the angle at which 
the rotation axis L5 about which the fifth link e5 and 
the sixth link e6 are turned inclines to the axes of the 
links e5 and e6. The second link e2 is turned through a 
first rotation angle qi relative to the first link el, 
the third link e3 is turned through a second rotation 
angle q2 relative to the second link e2, the fourth link 
e4 is turned through a third rotation angle qa relative 
to the third link e3, the fifth link e5 is turned 
through a fourth rotation angle q4 relative to the fourth 
link e4, the sixth link e6 is turned through a fifth 
rotation angle qs relative to the fifth link e5, and the 
base 21 is turned through a sixth rotation angle qe 
relative to the sixth link e6. When the links el to e6 
are extended in a straight aarm assembly, the rotation 
angles qi to qe are zero. 

In Expression (1), RzEG], Ry[9] and Rx[ei are 
rotation matrixes for turning the orientation of the 
body-attached coordinate system relative to the 
reference coordinate system. The rotation matrices Rx[9], 
Ry[6l and RztG] are used for turning the body-attached 
coordinate system through an angle 9 about the reference 
X-, the reference y- and the reference z-axis, 
respectively. Components of the rotation matrices Rz[9], 
Ry[9] and Rx[9] are expressed by Expressions (2) . (3) and 
(4) . respectively. 
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sin e 0 




cos G 0 
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where 6 is a variable and is substituted by an optional 
value. A matrix Rz[ql] is obtained by substituting 9 of 
Expression (2) by qi. In this specification, sin 9 and 
cos 0 represent the sine and cosine of the angle 0, and a 
symbol • " indicates multiplication. The position of the 
representative point p5 of the fifth link e5 is 
expressed by Expression (5) . 
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Suppose that the distance between the 

representative point T of the terminal device and the 

representative point pi of the first link el is iO, the 

distance between the representative point pi of the 

first link el and the representative point p2 of the 

second link e2 is il, the distance between the 

representative point p2 of the second link e2 and the 

representative point p3 of the third link e3 is i2, the 

distance between the representative point p3 of the 

third link eS and the representative point p4 of the 

fourth link e4 is iS, the distance between the 

representative point p4 of the fourth link e4 and the 
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representative point p5 of the fifth link e5 is i4, the 
distance between the representative point p5 of the 
fifth link e5 and the representative point p6 of the 
sixth link e6 is i5, and the distance between the 
representative point p6 of the sixth link e6 and the 
representative point S of the base is i6. 

The representative point pi of the first link el is 
coincident with a point, on the joint connecting the 
first link el and the second link e2, where the rotation 
axis lil about which the first link el and the second 
link e2 are turned, and the axis of the first link el 
intersect each other* The second representative point p2 
of the second link e2 is on the rotation axis Ii2 about 
which the second link e2 and the third link e3 are 
turned and on the joint connecting the links e2 and eS. 
The representative point p3 of the third link e3 is 
coincident with a point, on the joint connecting the 
third link e3 and the fourth link e4, where the rotation 
axis 1-3 about which the third link e3 and the fourth 
link e4 are turned, and the axis of the third link e3 
intersect each other. 

The representative point p4 of the fourth link e4 
is coincident with a point, on the joint connecting the 
fourth link e4 and the fifth link e5, where the rotation 
axis L4 about which the fourth link e4 and the fifth 
link eS are turned, and the axis of the fourth link e4 
intersect each other. The representative point p5 of the 
fifth link e5 is coincident with a point, on the joint 
connecting the fifth link e5 and the sixth link e6, 
where the rotation axis L5 about which the fifth link eS 
and the sixth link e6 are turned, and the axis of the 
fifth link e5 intersect each other. The representative 
point p6 of the sixth link e6 is coincident with a point, 
on the joint connecting the sixth link e6 and the base 
22, where the rotation axis L6 about which the sixth 
link e6 and the base 21 are turned, and the axis of the 
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sixth link e6 intersect each other. 

The position of the triaxial intersection point 
coincident with the representative point p5 of the fifth 
link e5 can be determined by using Expression (5) . A 
transformation matrix Ruh for converting the base 
coordinate system Sst into the reference coordinate 
system Lsb is produced. 

Rul^Rx[qx]#R>[qy]#R2[qz] (6) 

Values of the coordinates (Pwx, Pwy^ Pwz) of the 
representative point p5 of the fifth link e5 can be 
calculated by using Expression (7) . The coordinates of 
the representative point p5 of the fifth link e5 are 
transformed by using Expression (8) for the following 
operations . 









' ° 1 




<Pwx^ 


p5 = 


Py 


-Ruh* 


0 




Pwy 




^PzJ 




^i5 + i6^ 




^Pwz^ 



(7) 



^Pxn> 


' Pwx > 




Pyn = 


- Pwy + Pwz - iO 


... (8) 


^Pzn^ 


(^Pwy - Pwz - iO^ 





An x-coordinate expression Pxn expressing the x- 
coordinate of the representative point p5 of the fifth 
link e5 is produced. A yz added value represented by a 
yz addition coordinate expression Pyn is obtained by 
adding up the y- and the z-coordinate, and subtracting 
the distance iO between the terminal representative 
point T and the representative point pi of the first 
link el from the addition of the y- and the z-coordinate. 
A yz subtraction value represented by a yz subtraction 
coordinate expression Pzn is obtained by subtracting the 
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z-coordinate from the y-coordinate^ and subtracting the 
distance between the terminal representative point T and 
the representative point pi of the first link el from 
the remainder of subtraction of the z-coordinate from 
the y- coordinate. 

The representative point p5 of the fifth link e5 is 
coincident with the triaxial intersection point. 
Therefore, the position of the triaxial intersection 
point coincident with the representative point p5 can be 
determined by using Expression (7) . 

In step sl5, the articulated manipulator 20A 
modeled by the inverted model is transformed into the 
articulated manipulator 20B modeled by the equivalent 
model. Rotation angles Qi, Q2 and Q3 for the first link 
el, the second link e2 and the third link e3 are 
calculated. 

Transformation matrices Roi to R03 in Expression (9) 
are used for transforming the orientations of the 
representative points pi to p3 of the first link el to 
the third link e3 in the reference coordinate system Zsb. 
In Expression (9) , a indicates an angle at which the 
rotation axis LI about which the first link el and the 
second link e2 turn inclines to the axes of the links el 
and e2. The position of the representative point p5 of 
the fifth link e5 of the equivalent model shown in Fig. 
8 is expressed by Expression (10) . 



R,, = Rx [a]* Rz [Q J* Rx [-a] 

R^ = Ro, • Rz [Q,] " (9) 









0 ' 




0 


+ R03. 


0 











(10) 
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Suppose that the distance iO between the terminal 
representative point T and the representative point pi 
of the first link el is neglected, (il + i2) = 1, where 
(il + i2) is the distance between the representative 
point pi of the first link el and the representative 
point p3 of the third link eS, and (iS + 14) /(il + 12) = 
nr, where (13 + 14) is the distance between the 
representative point p3 of the third link e3 and the 
representative point p5 of the fifth link e5. 

The actual position of the representative point p5 
of the fifth link e5 is equal to a value obtained by 
multiplying a value calculated by using Expression (10) 
by the distance (il + 12) between the representative 
point pi of the first link el and the representative 
point p3 of the third link e3, and adding the distance 
iO between the terminal representative point T and the 
representative point pi of the first link el to the 
product of multiplication. The position of the 

representative point p5 of the fifth link e5 determined 
by using Expression (10) is expressed by Expression (11) 



p5 = 



P5y 

P5x = -sin a • sin Qi 

+ nr(-cos Q3 • sin a • sin Q, + (cos Q, • cos Q2 - cos a • sin Q, )sin Qj) 
P5y = -cos a • sin a + cos a • cos Qj • sin a 

-f nr(cos QgC-cos a • sin a • cos a • cos Qj • sin a) 

-(cosa^cosQj •sin Qi + (cos^ a«cosQ, +sin^ a)sin Q2)sin Q3) 
P5z = cos^ a + cosQ, •sin^ a + nr(cosQ3(cos^ a + cosQ, •sin^ a) 
+ (cos Q2 •sin a •sin Q, 
+ (- cos a • sin a • cos a • cos Q, • sin a) sin Q2 ) sin Q3 ) • • • (11) 

When the angle a at which the rotation axis LI 
about which the first link el and the second link e2 
turn inclines to the axes of the links el and e2 is 45°, 
Expression (12) is obtained by stabs titu ting the angle a 
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in Expression (11) by 45*^. 



P5: 



sin Qi 



2 



( cosQj-sinQi f ^ ^ sin Qi ^sinQ^ ^^.^ ^ ^ 

COS Q 



cosQ,^ ^ fcosQ-»sinQ, ( I cosQi^ . ^ . ^ 



(12) 



Expression (13) shows the x-coordinate expression 
Pxn representing the x-coordinate P5x of the 
representative point p5 of the fifth link e5 in the 
reference coordinate system, a yz addition coordinate 
expression Pyn representing the svim of the y- and the z- 
coordinate of the representative point pt of the fifth 
link e5, and a yz subtraction coordinate expression Pzn 
representing the remainder of sxabtraction of the z- 
coordinate from the y-coordinate of the representative 
point p5 of the fifth link e5. 



P5x = Pxn = nr • cos • cos • sin Q3 

sin (1 + nr • cos Q3 + nr • sin ♦ sin Q3 

P5y + P5z = Pyn 

= >^(nr» cos Q2 • sin Q, • sin Qj 

cos Q,(l+nr*cosQ3 +nr*sin •sin Q3) 

P5y-P5z = Pzn = l + nr*cosQ3 -nr^sin Qj •sin Q3 ---(IS) 



The expressions are thus transformed, and the 
simultaneous equations are solved to produce Expression 
(14) . A third rotation angle Q3 is calculated by using 
Expression (14) . Thus, analytical expressions 

representing the first rotation angle Q3/ a second 
rotation angle Q2 and third rotation angle Q3 in the 
equivalent model can easily be produced. 



40 



_ -2-2«nr^ +2#Pxn^ +Pyn^ .... 
cos Q3 = : • • • (14) 

In step sl6, the values of the x- coordinate P5x of 
the representative point p5 of the fifth link e5, the 
5 value of the sum of the y- and the z -coordinate of the 
representative point p5 of the fifth link e5, and the 
value of the remainder of subtraction of the z- 
coordinate from the y-coordinate of the representative 
point p5 of the fifth link e5 the remainder of 

10 subtraction of the z -coordinate from the y-coordinate of 
the representative point p5 of the fifth link e5 
calculated by using Expression (8) , namely, the x- 
coordinate expression Pxn, the yz addition coordinate 
expression Pyn and the yz s\ibtraction coordinate 

15 expression Pzn, in step sl4 are substituted into the 
expressions representing the first rotation angle Qi to 
the third rotation angle Q3 obtained in step sl5 to 
determine the niamerical values of the first rotation 
angle Qi to the third rotation angle Qa* Four 

20 combinations of those numerical values are possible, 
provided that the desired position of the base 21 is not 
a singular point. Step sl7 is executed after the 
numerical values of the first rotation angle Qi to the 
third rotation angle Q3 in the equivalent model have been 

25 determined. 

In step sl7, the first rotation angle Qi to the 
third rotation angle Q3 in the equivalent model 
determined in step sl6 are converted into a first 
rotation angle qi to a third rotation angle qa in the 

30 inverted model. Expression (15) represents cos qs. In 
Expressions (15), (16) and (17), a is an angle at which 
the rotation axis LB about which the third link e3 and 
the fourth link e4 turn inclines to the axes of the 
links e3 and e4 . 
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COS q3 = (cos ec a)^ • cos Q3 - (cot a)^ 



(15) 



where cosec a represents the cosecant of the angle a, 
and cot a represents the cotangent of the angle a. The 
third rotation angle qs in the inverted model can be 
determined by stibstituting the value of the third 
rotation angle Q3 in the equivalent model into Expression 
(15) • Values of cos q2 and sin qz are calculated by using 
Expression (16) 

cosq^ =-(cota(l-cosq3 •sin +coseca»cosQ2 •sin q3)sin Qg/D^ 
sinqj =coseca(cosa»cosQ2(l-cosQ3)-sinQ2#sinQ3)sinQ3/D2 ... (16) 

D2 included in Expression (16) is represented by 
Expression (17) . 

Dj =(cosa)^(l-cosq3)^ +(sinq3)^ (17) 

The value of the second rotation angle qa in the 
inverted model can be calculated by using Expression 
(16) . 

The first rotation angle Qi in the equivalent model 
is equal to the first rotation angle qi in the inverted 
model . Four combinations of the first rotation angle qi 
to the third rotation angle qa in the inverted model, 
similarly to those in the equivalent model, provided 
that the triaxial intersection point is not a singular 
point. 

After the first rotation angle qi to the third 
rotation angle qa in the inverted model have been 
determined in step sl7, a fourth rotation angle q4 to a 
sixth rotation angle qe in the inverted model are 
determined in step sl8. A transformation matrix Rwh for 
the fifth link e5 is represented by Expression (18) . 
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Rwh =[Ro3]'*Ruh 



(18) 



A transposed matrix obtained by transposing a 
transformation matrix R03 is multiplied by a 
transformation matrix Ruh for transforming the base 
coordinate system Zst with respect to the reference 
coordinate system £sb. The transformation matrix R03 can 
by obtained by using Expression (1) because the first 
rotation angle qi to the third rotation angle qa are 
known. The numerical solution of the transformation 
matrix Ruh can be obtained by using the foregoing 
expressions. The transformation matrix Ruh can be 
represented by Expression (6) . The fourth rotation angle 
q4 to the sixth rotation angle qe can be determined by 
solving Expression (19) when the numerical values of the 
components of the transformation matrix Rwh are known. 
In Expression (19) , a is an angle at which the rotation 
axis L5 about which the fifth link e5 and the sixth link 
e6 turn inclines to the axes of the links e5 and e6. 



Two combinations of the fourth rotation angle q4 to 
the sixth rotation angle qe in the inverted model are 
possible for each of the combinations of the first 
rotation angle qi to the third rotation angle qa, 
provided that the representative point of the base is 
not a singular point. Thus^ eight combinations of the 
first rotation angle qi to the sixth rotation angle qe 
are possible, provided that the triaxial intersection 
point and the base representative point are not singular 
points. Step sl9 is executed after the fourth rotation 
angle q4 to the sixth rotation angle qe in the inverted 
model have been determined in step sl8. 



In step sl9, the first rotation angle qi to the 



Rwh= Rz[q4]» Rx[a]* Rz^sl* «]• R^Qel 



(19) 



sixth rotation angle qe for the first link el to the 
sixth link e6 in the inverted model are substituted into 
Expression (20) to convert the first rotation angle qi to 
the sixth rotation angle qe into the first rotation angle 
9i to the sixth rotation angle Be for the first link cl 
to the sixth link c6 in the true model. After the first 
rotation angle 61 to the sixth rotation angle Ge have 
been determined, the positioning data calculating 
procedure is ended in step s20. 



04=q3 
e5=q2 

ee=qi 

(20) 



Thus, the first rotation angle 9i to the sixth 
rotation angle 06 for the links cl to c6 in the true 
model can easily be determined by the foregoing 
positioning data calculating procedure. Thus, the 
rotation angles through which the links must be turned 
can be determined to set the terainal device 22 in a 
desired orientation at a desired position. The links of 
the articulated manipulator are controlled on the basis 
of the thus calculated data to set the terminal device 
22 in the desired orientation at the desired position. 
The positioning data calculating procedure may be 
carried out either by a computer or by an operator. 

The thus calculated rotation angles for the links 
are analytical solutions. Therefore, those rotation 
angles are accurate and can be calculated in a short 
time as compared with those obtained by convergence 
calculation and interpolatory approximation. The 
rotation angles can be calculated by the positioning 
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data position procedure by a computer having a low 
processing ability. The eight combinations of the 
rotation angles can be obtained, and the optimum one of 
the eight combinations can selectively determined, 
considering energy cost and obstructs around the 
articulated manipulator. The first rotation angle 0i to 
the sixth rotation angle 06 for the first link cl to the 
sixth link c6 of the articulated manipulator 20 shown in 
Fig. 20 can easily be determined by transforming the 
true model into the inverted model. 

The rotation angles 9i to 06 for the links cl to c6 
in the true model may be determined by producing 
analytical equations having variables including the 
distances HO to H6 between the representative points of 
the links of the articulated manipulator, the angles a 
at which the rotation axes LI to L6 incline to the axels 
of the related links, the position T (Tx, Ty, Tz) of the 
terminal device 22, and the orientation (qo, qa, qt) of 
the terminal device 22 using the calculated data, and 
substituting values into the variables of the analytical 
equations . 

In this embodiment, the rotation angles of the 
links of the articulated manipulator are determined on 
an assumption that the angles at which the rotation axes 
incline to the axes of the related links connected by 
the diagonal joints are 45''. However, the angles at 
which the rotation axes incline to the axes of the 
related links connected by the diagonal joints may be 
different from each other or may be any suitable angles 
other than 45^. 

For example, in the articulated manipulator 20A in 
the inverted model shown in Fig. 7, the rotation angles 
qi to qe for the links el to e6 can be determined by 
multiplying the yz addition coordinate expression Pyn 
and the yz subtraction coordinate expression Pzn by 
suitable coefficients, even if the angle at which the 
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rotation axis LI about which the first link el and the 
second link e2 turn inclines to the axes of the links el 
and e2 is a, the angle at which the rotation axis L3 
about which the third link e3 and the fourth link e4 
turn inclines to the axes of the links e3 and e4 is 
and the angle at which the rotation axis L5 about which 
the fifth link e5 and the sixth link e6 turn inclines to 
the axes of the links e5 and e6 is y. The first to the 
third rotation angle can more easily be determined when 
at least one of the rotation axes other than those 
intersecting at the triaxial intersection point inclines 
at 45** to the axes of the related links. 

Even in a case where the angle at which the 
rotation axis LI about which the first link el and the 
second link e2 turn inclines to the axes of the links el 
and e2 is 45**, and the angle at which the rotation axis 
L3 about which the third link e3 and the fourth link e4 
turn inclines to the axes of the links e3 and e4 is not 
45** in the inverted model, the first to the third 
rotation angle can easily be determined by converting 
the joint connecting the third link e3 and the fourth 
link e4 into an equivalent model shown in Fig. 8. More 
concretely, the expression for adding up the y- and the 
z-coordinate of the triaxial intersection point, and the 
expression for subtracting the z-coordinate from the y- 
coordinate can be simplified, and thereby the first to 
the third angle can more easily be determined. 

Similarly, in a case where the angle at which the 
rotation axis L3 about which the third link e3 and the 
fourth link e4 turn inclines to the axes of the links e3 
and e4 is 45**, and the angle at which the rotation axis 
LI about which the first link el and the second link e2 
turn inclines to the axes of the links el and e2 is not 
45**, the first to the third rotation angle can easily be 
determined by converting the joint connecting the first 
link el and the second link e2 into an equivalent model. 



When the articulated manipulator has at least the 
rotation axis about which the two links connected by the 
diagonal joint among the joints connecting the first to 
the third link turn inclines at an angle of 45** to the 
axes of the two links connected by the same diagonal 
joint, the rotation angles for the links can more simply 
be determined. The triaxial intersection point in this 
embodiment is on the base in the true model, the 
triaxial intersection point may be on the terminal 
device. If the triaxial inter section point is on the 
terminal device, the rotation angles for the link can 
easily be determined without requiring the 
transformation of the true model into the inverted model . 

As shown in the true model, in a first articulated 
manipulator in which rotation axes LI, L2 and L3 near a 
fixed part intersect each other at a triaxial 
intersection point, a rotation axis L3 about which third 
and fourth links turn inclines at 45** to the axes of the 
third and the fourth link, and a rotation axis L6 about 
which fifth and sixth links turn inclines at an optional 
angle to the axes of the fifth and the sixth link, or in 
a second articulated manipulator in which rotation axes 
LI, L2 and L3 near a fixed part intersect each other at 
a triaxial intersection point, the rotation axis L3 
about which third and fourth links turn inclines at an 
optional angle to the axes of the third and the fourth 
link, and a rotation axis L6 about which fifth and sixth 
links turn inclines at 45** to the axes of the fifth and 
the sixth link, rotation angles for the links can more 
easily be determined by transforming a true model into 
an inverted model, and converting the joint having the 
rotation axis inclined at the optional angle to the axes 
of the related links into an equivalent model. 

As shown in the inverted model, in a third 
articulated manipulator in which rotation axes L4 , L5 
and L6 near a free part intersect each other at a 



triaxial intersection point, a rotation axis LI about 
which first and second links turn inclines at 45° to the 
axes of the first and the second link, and a rotation 
axis L3 about which third and fourth links turn inclines 
at an optional angle to the axes of the third and the 
fourth link, or in a fourth articulated manipulator in 
which rotation axes L4 , L5 and L.6 near a free part 
intersect each other at a triaxial intersection point, 
the rotation axis LI about which first and second links 
turn inclines at an optional angle to the axes of the 
first and the second link, and a rotation axis L3 about 
which third and fourth links turn inclines at 45*^ to the 
axes of the third and the fourth link, rotation angles 
for the links can easily be determined by converting the 
joint having the rotation axis inclined at the optional 
angle to the axes of the related links into an 
equivalent model . 

The rotation angles for the links can be determined 
even if the rotation axis of the joint connecting the 
third link e3 and the fourth link e4 is orthogonal to 
the axes of the links eS and e4 as shown in Fig. 8. 

Fig. 9 shows a model modeling an articulated 
manipulator in a second embodiment according to the 
present invention. In the model shown in Fig. 9, a sixth 
link e6 and a base 21 corresponding to those of the 
inverted model shown in Fig. 7 are fixedly joined 
together. Rotation angles qi to qs for a first link el 
to a fifth link e5 can be determined by the aforesaid 
positioning data calculating procedure. 

As apparent from the foregoing description, 
according to the present invention, the first to the 
sixth angles for locating the object in a desired 
orientation at a desired position can be determined in a 
short time. Thus, the rotation angles through which the 
links are to be turned can be deteannined every time the 
object is moved. For example, data on the orientation 
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and position of the object moving along a prescribed 
path is entered continuously to change the angular 
position of the links can sequentially be changed on the 
basis of the continuously entered data. Thus, the object 
can quickly and smoothly be moved to the desired 
position. 

The values of the rotation angles can analytically 
be determined, and all the possible combinations of the 
rotation angles can be obtained. In a six-degree of 
freedom articulated manipulator, eight combinations of 
rotation angles can be obtained. Optimum one of the 
eight combinations of the rotation angles for the links 
of the articulated manipulator can be chosen to locate 
the object in a desired orientation at a desired 
position. For example, optim\am one of the eight 
combinations of the rotation angles is selected taking 
into consideration energy cost and obstacles around the 
articulated manipulator. 

According to the present invention, the first to 
the fifth rotation angles for locating the object in a 
desired orientation at a desired position can be 
determined in a short time. Thus, rotation angles for 
the links can be determined every time the ob j ect is 
moved. . For example, data on the orientation and 
position of the object moving along a prescribed path is 
entered continuously to change the angular position of 
the links can sequentially be changed on the basis of 
the continuously entered data. Thus, the object can 
quickly and smoothly be moved to the desired position. 

The values of the rotation angles can analytically 
be determined, and all the possible combinations of the 
rotation angles for moving the object to the desired 
position can be obtained. One of the combinations of the 
rotation angles for the links of the articulated 
manipulator can be chosen to locate the object in a 
desired orientation at a desired position. For example. 



optimum one of the combinations of the rotation angles 
is selected taking into consideration energy cost and 
obstacles around the articulated manipulator. 

According to the present invention, the calculating 
device is capable of quickly determining the first to 
the sixth rotation angles to locate the object in a 
desired orientation at a desired position. Thus, the 
rotation angles through which the links are to be turned 
can be determined every time the object is moved. The 
output device sends the calculated data to the 
articulated manipulator. For example, the input device 
enters data on the orientation and position of the 
object moving along a prescribed path continuously, and 
the links are turned through the rotation angles 
provided by the output device, and thereby the angular 
position of the links can sequentially be changed on the 
basis of the continuously entered data. Thus, the object 
can quickly and smoothly be moved to the desired 
position. 

The calculating device determines values of the 
rotation angles analytically, and all the possible 
combinations of the rotation angles to move the object 
to the desired position can be obtained. For exsunple, in 
a six-degree of freedom articulated manipulator, eight 
combinations of rotation angles can be obtained. One of 
the combinations of the rotation angles for the links of 
the articulated manipulator can be chosen to locate the 
object in a desired orientation at a desired position. 
For example, optimxam one of the combinations of the 
rotation angles is selected taking into consideration 
energy cost and obstacles around the articulated 
manipulator . 

According to the present invention, the calculating 
device is capable of quickly determining the first to 
the fifth rotation angles to locate the object in a 
desired orientation at a desired position. Thus, the 
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rotation angles through which the links are to be turned 
can be determined every time the object is moved. The 
output device sends the calculated data to the 
articulated manipulator. For example, the input device 
enters data on the orientation and position of the 
object moving along a prescribed path continuously, and 
the links are turned through the rotation angles 
provided by the output device, and thereby the angular 
position of the links can sequentially be changed on the 
basis of the continuously entered data. Thus, the object 
can quickly and smoothly be moved to the desired 
position. 

The calculating device determines values of the 
rotation angles, and all the possible combinations of 
the rotation angles can be obtained. One of the 
combinations of the rotation angles for the links of the 
articulated manipulator can be chosen to locate the 
object in a desired orientation at a desired position. 
For excunple, optimum one of the combinations of the 
rotation angles is selected taking into consideration 
energy cost and obstacles around the articulated 
manipulator . 

According to the present invention, the rotation 
axes about which the object and the sixth link turn, the 
sixth and the fifth link turn, and the fifth and the 
fourth link turn, respectively, are coincident at the 
triaxial intersection point. Therefore the coordinates 
of the triaxial intersection point can uniquely be 
determined by an orientation controller when the 
position and orientation of the object is determined. 
Thus, the orientation controller is able to determine 
analytically the first to the sixth rotation angle for 
the links for locating the object in a desired 
orientation at a desired position. Whereas the 

conventional articulated manipulator provided with six 
joints is incapable of analytically determining the 
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rotation angles, the articulated manipulator of the 
present invention is capable of analytically deteirmining 
the rotation angles. Consequently, the object can 
quickly and accurately be located. 

When the rotation axis about which the two links 
connected by at least the diagonal joints among the 
joints connecting the first to the third link turn 
inclines at an angle of 45*" to the axes of the links 
connected by the same diagonal joint, the orientation 
controller is able to determine the rotation angles by 
using simplified expressions. Consequently, time 

necessary for the orientation controller to determine 
the first to the sixth rotation angles can further 
shortened. 

According to the present invention, the rotation 
axes about which the object and the sixth link turn, the 
sixth and the fifth link turn, and the fifth and the 
fourth link turn, respectively, are coincident at the 
triaxial intersection point. Therefore the coordinates 
of the triaxial intersection point can uniquely be 
determined by an orientation controller when the 
position and orientation of the object is determined. 
Thus, the orientation controller is able to determine 
analytically the first to the sixth rotation angle for 
the links for locating the object in a desired 
orientation at a desired position. 

When the rotation axis about which the two links 
connected by at least the diagonal joints among the 
joints connecting the first to the third link turn 
inclines at an angle of 45** to the axes of the links 
connected by the same diagonal joint, the orientation 
controller is able to determine the rotation angles by 
using sin^jlified expressions. Consequently, time 

necessary for the orientation controller to determine 
the first to the sixth rotation angles can further 
shortened. Whereas the conventional articulated 
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manipulator provided with five joints is incapable of 
analytically determining the rotation angles, the 
articulated manipulator of the present invention is 
capable of analytically determining the rotation angles. 
Consequently, the object can quickly and accurately be 
located. 

Although the invention has been described in its 
preferred embodiments with a certain degree of 
particularity, obviously many changes and variations are 
possible therein. It is therefore to be understood that 
the present invention may be practiced otherwise than as 
specifically described herein without departing from the 
scope and spirit thereof. 



